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SYSTEM AND DEVICE FOR A SELF ORIENTING DEVICE 
Technical field 

The present invention refers to a self orientating device , 
particular a vacuum-cleaning device , and more exactly to a system 
and a device for the orientation in the immediate surroundings 
by means of an ultrasonic sonar system offering an advantageous 
sensing of obstacles in the course of the moving autonomous 
device . 

Background of the invention 

For many years there has been a desire to provide, for instance, 
an autonomous apparatus for floor treatment, particularly a 
vacuum-cleaner, which is controlled by a sensing system sweeping 
around the horizon in analogy, for example, with a ship radar. 
Then the desire is, that the apparatus should be able to 
orientate itself in a room, such that it, for instance, will be 
able to perform a cleaning function according to a predetermined 
pattern or a predetermined strategy and at the same time avoid 
colliding with different obstacles, which may be arranged in the 
room, besides avoiding collisions with the walls of the room. 

Such a system is disclosed in the International Patent Applica- 
tion WO 95/26512 by the same applicant and which is expressly 
incorporated here by reference. 

Still the system according to WO 95/26512 is rather complicated 
and it additionally utilizes a number of transponder devices for 
the initial orientation. These transponders are localized at a 
number of points in the room to be cleaned and the transponders 
are used as reference points. Another characteristic of the 
system according to WO 95/26512 is the utilization of an 
ultrasound transmitter placed on top of the device. This 
transmitter is used both for localization of the transponders 
scattered around the room and is simultaneously used as a 
proximity sensing system for detecting possible obstacles near 
to the moving apparatus. One disadvantage of the disclosed 
apparatus is due to limited bandwidth and therefore there will 
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sometimes be present "dead" sectors. 
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Description of the drawings 

The invention will be described in form of a preferred embodiment 
by making reference to the accompanying drawings, in which: 

Fig. 1 demonstrates a top view of an autonomous device in an 
embodiment of a vacuum-cleaning robot incorporating the 
present invention; 

Fig. 2 demonstrates a side view of the device of Fig. 1; 

Fig. 3 demonstrates a side view of the device of Fig. 1; 

Fig. 4 demonstrates a hardware block diagram of the device 
according to Fig. 1 illustrating an embodiment in- 
corporating the present invention; 

Fig. 5 shows a graph illustrating directivity of. a sonar 
transducer utilized in the present system; 

Fig. 6 shows a graph illustrating directivity of a naked 
microphone for a sonar system; 

Fig. 7 shows a graph illustrating the directivity of a mi- 
crophone provided with hollow pipes utilized in the 
present sonar system; 

Fig. 8 is a vertical cut of a microphone provided with hollow 
pipes for the received sound; 

Fig. 9 illustrates build-up of a stripe-shaped transducer; 

Fig. 10 shows a simplified sonar transmitter block diagram 
utilized in an embodiment of the present system; 



Fig. 11 shows a sonar receiver block diagram utilized in an 
embodiment of the present system; 
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in contact with the floor. Due to this balancing the device may 
easily climb the edges of floor carpets and the like. The balance 
is also sensed by a tilt switch in the device. 

In another embodiment the stripe-shaped transducer is divided 
into two stripe-shaped transducers, on upper portion and one 
lower portion. The number of microphone units then will be 
positioned between the two portions of the sonar transmitter. 

In figure 4 is illustrated a hardware block diagram of the device 
according to Figures 1, 2 and 3. The hardware is essentially 
built around a data processor type MC68332 from Motorola Inc. The 
signals from the slotted disc encoders are connected to Timer 
Processor Unit (TPU) inputs of the MC68332. The processor 
(running in QDEC mode) giving position information with an 
accuracy of 2000 slots per revolution controls, via respective 
drivers, left and right wheel motors. The wheel motors are 
separately controlled by pulse-width modulated signals of 5 kHz 
generated by to more channels from the Timer Processor Unit in 
the main processor. The processor also controls two additional 
motors, one for the rotating brush and another for the fan 
generating the necessary vacuum for the general function of the 
vacuum-cleaner. Air from the fan motor is additionally in a known 
manner utilized for cooling purposes and the air is exhausted at 
a gilled outlet at the top of the device. 

The processor is controlled by software stored in a number of 
different types of digital memories for example of type FPROM, 
RAM or EEPROM, which are all well known to a person familiar to 
computer techniques. Communication with the control system may 
be obtained through a standard RS-232 interface. Additionally the 
processor has its own clocking system also known from prior art. 
The system as illustrated in Fig. 4 further comprises three touch 
switches, L-Bumper, R-Bumper and tilt switch, and a transmitter 
and a receiver for a sonar localization sensing system, which 
portions constitutes the part of the system involving the present 
invention and which will be described more in detail below. 
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The other electrode 34 consists of a movable film which is 
metallized on the side not in contact with the corrugated back- 
plane 30. In the preferred embodiment the stripe-shaped transduc- 
er 10 is formed by first attaching a corrugated copper film to 
the perimeter of the inner basic curved structure and on top of 
the corrugated copper film a plane insulated conductive film 
forming the moving part of the stripe-shaped electrostatic 
transducer. Thus the insulation of the conductive film is facing 
the corrugated copper film. The corrugated copper film has an 
adequate waffle pattern. Note that this preferred device is 
intended to transmit in the opposite direction compared to the 
general Sell type demonstrated in Fig. 9. In front of the 
transducer is additionally placed a protective wire mesh at a 
rectangular opening along the perimeter of the bumper 16, 
covering a forward angle of the order 150°. Thus the corrugated 
film constitutes one electrode and the insulated conductive film 
the other electrode of the transducer. The transmitter will be 
non-linear which implies that it rectifies an applied AC signal 
if a biasing voltage is not applied together with the AC signal. 
Documentation on Sell transducers is for instance found in I EE 
Transactions on Ultrasonics, Ferroelectrics and Frequency 
Control, #1 Vol 42, Jan 1995, which is expressly incorporated 
here by reference. The utilized transducer will be further 
described below. 

The other important parts of the sonar system are the micropho- 
nes. The microphones are mounted behind an arrangement of two 
vertically aligned hollow pipes for the sound in order to give 
them a desired directivity. In Fig. 6 is demonstrated the 
horizonal and vertical directivity of a microphone suitable for 
a sonar system. The diagram plots the generated relative voltage 
in a vertical plane -100° to +100* and similarly in a horizontal 
plane -100« to +100°. The directivity of a naked microphone is 
almost omni-directional, as indicated by the diagram of Fig. 6. 

Introducing the vertically aligned horizontal hollow pipes or 
tubes together with the already obtained narrow vertical 
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cycle of the transmitted burst can be varied by changing the 
programming of the PSP function. Burst length (number of pulses) 
is controlled by changing the programming of the PCSO signal from 
QSM. All this is done in a software module (not shown) which will 
be obvious to a person skilled in the art. 

In Fig, 10 is illustrated that the signal from the MC68332 CPU 
is output to a field effect switch, FET, having its source 
electrode connected to ground and via a transformer is driving 
the stripe-shaped ultrasound transducer. A primary 12 volts 
supply to the drain electrode of the field effect transistor, 
which keyed on its gate by the CPU MC68332, generates pulses of 
about 600 Vpp in the secondary winding of the transformer. The 
capacitance of the transducer and the inductance of the secondary 
winding form a parallel resonance circuit tuned to the operation 
frequency of the ultrasonic transmitter. 

The receiver demonstrated in a simplified receiver block diagram 
in Fig. 11 uses an analog multiplexer to select one of the three 
main microphones 12 or an extra side microphone (not shown in the 
diagram) for a wall tracking, (or one of the two floor sensing 
microphones in front of the driven wheels 17, 18), as input to 
a bandpass- filter followed by an envelope detector. The micro- 
phones in the present embodiment are connected to individual 
amplifiers of about 40 dB gain. The bandpass-filter of the 
present embodiment is a 6 pole filter having a bandwidth of 15 
kHz centered at 40 kHz and a filter gain of about 40 dB. The 
envelope detector like the preamplifiers and the bandpass-filter 
constitute a standard configuration well known to a person 
skilled in the art. The signal from the envelope detector is then 
fed to a 12 bit serial A/D-converter, under control of the QSM. 
Samples are stored at a rate of 40 kilosamples per second, 
starting one millisecond before and ending twentyfour millisec- 
onds after the transmitted ultrasonic burst. Clocked by A/D 
transfers the QSM outputs the peripheral chip selects PCSO and 
PCS1 . PCS1 is issued at positions number eight and sixteen, 
triggers an interrupt to the main CPU, indicating that there are 
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for peaks above a fixed threshold and offset by the calculated 
background noise level. 

The exact location of an obstacle is not known by only using the 
information from each microphone since the detected object could 
be located anywhere on en ellipsis. To pinpoint the exact 
location of the nearest obstacle trigonometry is used in a 
standard geometrical way apparent to a person skilled in the art. 
Only the distance and angle to the nearest obstacle is calculated 
due to the complex mathematics that must be performed in real 
time. Also this is only done when travelling at low speed or 
stopped . 

When traveling at high speed , the information from the different 
microphones is uses as is, to get an approximation of the 
distance to obstacles, and then switch to low device speed when 
obstacles are close enough. 

Navigation 

Normally the device moves in a straight line until an obstacle 
is encountered. If no obstacle is detected within 40 cm from the 
front, or 10 cm from the sides, high speed is used. High speed 
for the present embodiment corresponds to about 40 cm/s. If any 
obstacle is seen within this section, low speed is used. Low 
speed is then set to about 14 cm/s. Detection of an obstacle 
within a distance of a few centimeters causes the device to stop. 
After stopping, the closest obstacle is checked and the angle to 
the object is used as argument for calculating a new direction 
for travel. If the obstacle is found far out on either side, a 
small base angle is used. On the other hand, if the hit is 
straight ahead, a base angle of 60 degrees is used. To the base 
angle, a random angle of up to 60 degrees is added. In this way 
the autonomous device can find its way through a narrow passage 
with small turns and still bounce efficiently between bare walls. 
The distance between stops and the number of turns is monitored 
so that the "free run mode" switches into "stuck, breakout mode" 
if the travelled distance does not exceed a set minimum after a 
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analog inputs. 

It will be understood by those skilled in the art that various 
modifications and changes may be made to the present invention 
without departure from the spirit and scope thereof defined by 
the appended claims. 
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CLAIMS 

A proximity sensing system for an autonomous device 
x a proximn-y » mi for carrying out 

a specific cleaning q£ o nicropro . 

~ —j:; P ro,imit "I— «~ «hich comprises 

at least one transmit g forward directed 

^chanical sensing member (16) in form o 

bumper, characterised in that stripe . shaped ultrascund 

said transmitting member is a strip p 
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rstrr^rhlnT-drecTTn front of the device. 
2 . The system according to claim 1. ^charac 
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(10 , mounted on - ^t * Z Z tralic microphone 

receiving member having at ieas» 



units . 



transmitting member is civioe stripe- 
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TlZZZZTZL Z" the vertical distribution of 
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said receiving member comprises a »i-P ^ ^ ^ 

Th e system according to ciaim 5. characterised in that 
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said hollow pipes (12a, 12b) of the receiving microphone units 
are aligned vertically in respect to each other to produce an 
improved directivity in the vertical plane. 

7. The system according to claim 5, characterized in that a 
further microphone unit (12) is pointed to one side of the device 
to be used in a wall tracking operation. 

8. The system according to claim 2 or 3, characterized in that 
said transmitting member during each repeated transmission 
transmits a sequence of closely spaced pulses, the echoes of 
which will be integrated into one sampled reflection at a 
specific reflection distance by said receiving system. 

9. The system according to any of the previous claims, charac- 
terized in that said mechanical sensing member (16) is actuating 
at least one touch sensor if the device makes contact to an 
obstacle in the course of the moving device, 

10. A device for navigation of an autonomous device being 
provided with motor driven wheels (17, 18) for carrying out some 
specific cleaning function, said device comprising members for 
the proximity orientation and guiding of the device by means of 
a microprocessor system and a proximity sensing system which 
comprises at least one transmitting member and one receiving 
member and a mechanical sensing member in form of a forward 
directed bumper (16), characterized in that said transmitting 
member is a stripe-shaped ultrasound transducer (10) positioned 
at the front of the device and transmitting ultrasonic waves with 
a narrow vertical distribution within a wide sector in front of 
the device. 

11. The device according to claim 10, characterized in that 
said transmitting member is a semicircular capacitance film- 
transducer mounted on the perimeter of the device together with 
said receiving member having at least three microphone units. 
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12 . The device according to c prese nting 
sai d transiting member is d- ^ and a lower stripe- 

an upP er ^-^ZTl^S -tween the, the receiving 
shaped ultrasound transauc 

member . 

. m 11 or 12, characterized in 
13. The device accor ding to cXai ^ in the £ro nt 

that said «- smi ^ o :^I r limi t the vertical distribution 
of transmitted and receive 

10 or 12 characterized in 
14 . The system according to ^ ^ ,„ lorophon e units 

tha t said receiving ,e^r cc.pr.se o ^ ^ soond to 
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further improve the directrvr y n ^ 

15 . The device accord i« , to claim ^"f^nol'units 
sai d hollow pipes (!».. " b, in ° f respect ro each other to produce 
(12) ere aligned vertrcaliy^n P 
an improved directivrty xn the 

, m 14 characterised in that a 
16 . T he device according «• ^ ^ _ side oi th e device 

rrurr:^ — 

11 or 12 characterized in 
„. T he device according to ciarm tranOTission 
that said transmitting puls es, the echoes of 

transmits a sequence of closely P , t . 

which will he integrated «to 
specific reflection distanoe by 

„, the previous claims 10 to 
18 . T he device according to any^of P ^ (M) is 

16 . characterised is that -* ^ device maKes contact 

gating at least one -uch ~ M device . 
to an obstacle in the co 
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